MOTOR CONTROLLER 
BACKGROUND OF THE INVENTION 



1 . Field of the Invention 

The present invention relates to a motor controller for performing 
control of a motor using analog feedback signals from encoders for detecting 
position and/or velocity of the motor or a movable member driven by the 
motor. 

2. Description of the Related Art 

Encoders to respectively output analog feedback signals of sine waves 
of A phase and B phase are generally adopted as detectors for detecting 
position and veic^city of a motor or a movable member driven by the motor. 
An offset as displacement from a set value of a central voltage of amplitude, 
the amplitude and phase difference of the analog feedback signals of sine wave 
vary. Therefore, the analog feedback signals are observed using a special 
measurement device such as an oscilloscope to obtain information on the 
offsets, the amplitudes and the phase difference, and the feedback signals are 
adjusted based on the observation. 

In the conventional art, an expert in operation of the oscilloscope is 
required to obtain the information on the offsets, amplitudes and phase 
difference using the special device such as oscilloscope in adjusting and 
confirming the analog feedback signals, and it is further required to make 
judgment on necessity of adjustment of the signals based on the information 
displayed on the oscilloscope. Thus, it has been difficult to adjust and 
confirm the signals based on the information on the offsets, amphtudes and 
phase difference. 



SUMMARY OF THE INVENTION 



The present invention enables obtaining information on offsets, 
ampUtudes and a phase difference of analog feedback signals from encoders 
with ease. 

The motor confroller of the present invention performs control of 
position or velocity of a movable member mechanically connected with a 
motor using analog feedback signals from encoders for detecting rotational 
position or velocity of the motor, or position or velocity of the movable 
member, and the motor controller includes means for displaying information 
on at least one of amplitudes, offsets and a phase difference of the analog 
feedback signals on a display section of the motor confroller or a host 
controller connected with the motor controller. Thereby, status of the 
feedback signals from the encoders can be perceived. 

Further, the motor confroller of the present invention may include 
means for displaying results of comparison of amplitudes and/or offsets of the 
^ analog feedback signals with respective predetermined values on the display 
section of the motor controller or the host confroller. 

The display section of the motor controller may include a LED display 
device or a seven-segmented display device. The information on at least one 
of the amplitudes, the offsets and the phase difference may be obtained based 
on A/D conversion values of the analog feedback signals. The motor 
controller may include means for calculating at least one of the offsets, die 
amplitudes and the phase difference of the analog feedback signals of two 
different phases. 
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BRIEF DESCRIPTION OF THE DRAWTNGS 



FIG. 1 is a block diagram of a servo confrol system including a motor 
confroller according to an embodiment of the present invention; 

FIG. 2 is a diagram showing an example of wave forms of analog 
feedback signals from encoders; 

FIG. 3 is a diagram showing wave forms of the analog feedback signals 
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with their offsets canceled; 

FIG. 4 is a flowchart of encoder adjustment and confirmation 
processing to be performed by a processor of the motor controller; 

FIG. 5 is a flowchart of offset detection processing; 

FIG. 6 is a flowchart of amphtude detection processing; and 

FIG. 7 is a flowchart of phase difference detection processing. 

DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS 

FIG. 1 shows an example of a motor controller 2 for controlling a 
spindle motor 3 of a machine tool imder control of a numerical controller 1 as a 
host controller. 

In FIG. 1, a motor controller 2 comprises a position control section 21, 
a velocity control section 22, a driving circuit 23, detecting circuits 24 and 25, 
an arithmetic section 26, a storing section 27 and a display section 28 having a 
display device such as a LED display and a 7-segmented display. The display 
section 28 may be provided out of the motor controller 2 to be connected with 
the motor controller. An encoder 5 provided at an output shaft of the motor 3 
and an encoder 6 provided at a spindle 4 respectively output analog signals of 
A-phase and B-phase having a phase difference of 90° in the form of sine 
waves to the detecting circuits 24 and 25 as velocity and position feedback 
signals. 

The detecting circuit 24 performs an A/D conversion of the analog 
feedback signal fi-om the encoder 5 and a compensation of the signal using 
amphtude ratio and phase difference compensation parameters, to feed back 
the compensated signal to the velocity control section 22 as a velocity feedback 
digital signal. The detecting circuit 25 performs an A/D conversion of the 
analog feedback signal from the encoder 6 and a compensation using amplitude 
ratio and phase difference compensation parameters, to feed back the 
compensated signal to the position control section 21 as a position feedback 
digital signal. 



When a motion command is issued from the numerical controller 1 to 
the motor controller 2, the position control section 21 of the motor controller 2 
performs a position feedback control based on the motion command from the 
numerical controller 1 and the position feedback digital signal from the 
detecting circuit 25 to obtain a velocity command and outputs the obtained 
velocity command to the velocity control section 22. The velocity control 
section 22 performs a velocity feedback control based on the velocity 
command from the position control section 21 and the velocity feedback digital 
signal from the detecting circuit 24 to obtain a torque command and outputs the 
obtained torque command to the driving circuit 23 to drivingly control the 
■ motor 3. Functions of the control sections, etc. other than the driving circuit 
p 23 in the motor controller 2 are realized by software processing performed by a 
P processor of the motor controller 2 

2 As shown in FIG. 1 , the arithmetic section 26 and the display section 

^ 28 are provided in the motor controller 2 according to the present invention 

Thus, according to the present invention, offsets, an amplitude ratio, a 
j^y phase difference of the analog feedback signals and compensation parameters 
ffi are automatically obtained by tiie arithmetic section 26 and the obtained 
p compensation parameters are written to be updated in the storing section 27. 
^ Further, the obtained offsets, amplitude ratio and phase difference are 

displayed by the display section 28 of the motor controller 2 on the display 
device such as 7-segmented LED display of the motor conti-oUer 2 and/or 
displayed on a display device provided in the numerical contioUer 1. 

The processing to be performed by the arithmetic section 26 will be 
described. 

FIG. 2 shows an example of analog feedback signals fed back from the 
encoders 5 and 6. The analog feedback signals are in the form of sine waves 
of A phase and B phase having a phase difference of (90°+a). The A-phase 
and B-phase signals have offsets of AA(=V0+6A) and AB(=V0+5B), and 
ampUtudes of a(V) and b(V), respectively. 

Thus, the A-phase feedback signal f(0) is expressed as: 
f(e) = asine + AA 
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The B-phase feedback signal g(e) is expressed as: 

g(e) = bsin(e+90°+a) + AB 

= b-cos(6+a) + AB 

Hereinafter, f(e) and g(e) are simply referred to as "f and "g"- 

The feedback signals with the offsets cancelled are expressed as 
follows: 

F(e) = asine 

G(0) = bcos(0+a) 

^ Hereinafter, F(e) and G(0) are simply referred to as "F" and "G", 

p respectively. 
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The feedback signals with the offsets cancelled are shown in FIGS. 3. 
After switching an operation mode of the numerical controller 1 to an 
encoder adjusting/confirmation mode and drive of the spindle is started, the 
processor of the motor controller starts the processing as shown in FIG. 4. 

First, the offset data AA and AB of A-phase and B-phase are obtained 
based on the digital feedback signals after being subjected to A/D conversion 
by the detecting circuits 24 and 25. Each of the obtained offset data AA and 
AB are divided by an amplification of the A/D conversion to obtain respective 
display data in the unit of mV, and displayed by the display section 28 and/or a 
display device of the numerical controller 1 (Step SI). 

An example of processing for obtaining the offset data is shown in FIG 
l,r> c Pf^'^f ^^'^ executes this processing at every predetermined period In 

5, only the processing for obtaining the offset data of A-phase is shown 
and the offset data of B-phase are obtained in the same manner. 

^n.^} A-phase feedback signal f converted into digital signal is read 
(btep 101). It is determmed whether or not a value stored in a register R(f) 
for stormg the feedback signal data of A-phase is "0" (Step 102). The register 
R(f), registers Amax and Amin, and registers for storing indexes i and j are all 
set to "0" m an mitial setting when the encoder adjusting/confirming 
processmg is started. Thus, a determination result in Step 1 02 is initially 

YES" and the procedure proceeds to Step 1 1 1 where the feedback signal data 
t read m Step 1 0 1 is stored. It is determined whether or not the indexes i and i 
are of a set value C (Step 1 12). Since the indexes 1 and j are initially set to 
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"0", the procedure in this processing period terminates. 

In the subsequent processing period, since the value stored in the register 
R(f) is not "0", the procedure proceeds from Step 102 to Step 103 to obtain a 
sign of a difference obtained by subtracting the value of the register R(f) from 
the data f read at Step 101. It is determined whether the sign is changed or 
not by comparing the obtained sign and the sign stored in a register for storing 
the sign (Step 104). If the register stores no sign, i.e. stores "0", it is deemed 
that the sign is not changed irrespective of the obtained sign of "+" or 

In the case where the sign is not changed, the procedure proceeds to Step 
1 10 where the sign obtained in Step 103 is stored in the register and then the 
data f read in Step 1 0 1 is stored in the register R(f) (Step 111). Then, it is 
determined whether or not the indexes i and j are of the set value C (Step 1 12) 
and if the indexes are not of the set value C, the procedure of this processing 
^ period terminates. Subsequently, the abovementioned processing is 
g repeatedly executed at every processing period and when it is determined that 
fy the sign is changed at Step 104, it is determined whether or not the sign is 
fy changed from "+" to "-" or "0". Although it is unlikely that the sign obtained 
g in Step 103 is "0", the sign might be "0" in dependence of resolution of the 

A/D converter and thus the determination in this step includes the case of the 
g change of the sign from to "0". 

^ As can been seen in FIG. 2, the sign of the difference obtained by 

g subfracting the feedback signal value in the present processing period from the 

g feedback signal value in the inmiediately preceding processing period 

P continuously becomes "+" until a value of the feedback signal f is of a local 

maximum. When the value of the signal f exceeds a local maximum, the sign 
of the difference becomes Thus, if the sign is changed from "+" to "-" 

or "0", it is determined that the value stored in the register R(f) is a local 
maximum and an absolute value thereof is added to the value of the register 
Amax (Step 1 06). The register Amax is set to "0" in the initial setting. Then, 
the index i is incrementally increased by "1" (Step 107) and the procedure 
proceeds to Step 110. 

When it is determined that the sign has changed in Step 104 and the 
determination result in Step 105 is "NO", i.e., the sign has changed from to 

or "0", it is determined that the value stored in the register R(f) is a local 
minimum and an absolute value thereof is added to the value of the register 
Amin (Step 108). Then, the index j is incrementally increased by "1" (Step 
109) and the procedure proceeds to Step 110. 

Subsequently, the abovementioned processing is repeatedly executed 
until both of the indexes i and j reach the set value C. When the indexes i and 
j reach the set value C, the register Amax stores the sum of the local 
maximums of the number of times C, and the register Amin stores the sum of 
the local minimum of the number of times C. Thus, when the indexes i and j 
reach the set value C in Step 1 12, an average value of the local maximums is 
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obtained by dividing the value of the register Amax by C and an average value 
of the local minimums is obtained by dividing the value of the register Amin 
by C. Then, the average value of the local minimums is subtracted from the 
average value of the local maximums and the obtained difference is divided by 
2 to obtain an amplitude of the feedback signal. A offset value AA is 
obtained by adding the obtained amplitude to the average value of the local 
minimums. The above calculations of the offset value AA is expressed as 
follows: 

AA = (Amin/C) + (l/2){(Amax/C) - (Amin/C)} 
= (l/2){(Amax + Amin)/C} 

Thus obtained offset data AA of A-phase is multiphed by a conversion 
coefficient k in the conversion from the digital signal value to the analog signal 
value (mV) to obtain display data for A-phase offset. The obtained data is 
1^ displayed by the display section 28 and/or sent to the numerical controller 1 to 
I be displayed by the display device of the numerical confroUer 1 (Step 1 14). 

A reference value VO (2.5V in the example of FIG. 2) is subtracted from 
fy the analog offset value to obtain an offset value 5A from the reference value 
VO, and it is determined whether or not the offset value 5A is within a 
reference range (Step 115). An indication that the offset value 5A is within 
the reference range or not is displayed by the display section 28 (Step 116 or 
H 117). For example, an indication of "O" is displayed at a section for 

displaying an offset status of A-phase on a display device of the display section 
g 28 if the offset value 5A is not within the reference range, and no indication is 
P displayed at that section if the offset value 5A is within the reference range. 
H" A signal indicating completion of detection of the A-phase offset is outputted 
(Step 118) and the processing terminates. 

For the B-phase, the similar processing is performed to obtain offset data 
AB of B-phase and offset display data of B-phase and the obtained display data 
are displayed by the display section 28 and/or the display device of the 
numerical controller 1 . Further, an indication that the offset value 6B is 
within the reference range or not is displayed. 

Thus, the offset data AA and AB of A-phase and B-phase are obtained 
and the offset display data of A-phase and B-phase are displayed. The 
procedure proceeds to Step S2 in which ampUtude data "a" of A-phase and 
amplitude data "b" of B-phase are obtained. The amplitude data "a" and "b" 
may be obtained by adopting the value of "{(Amax/C) - (AminyC)}/2" 
obtained in Step 113. In this embodiment, however, the amplitude data "a" 
and "b" are obtained based on the feedback signal data after cancehng the 
offsets in order to obtain more precise data. 

As can be seen from FIG. 3, since the phase difference a is generally of 
a small value, when one of the A/D converted values of A-phase and B-phase 
after cancehng the offsets is substantiaUy "0", the other of the A/D converted 
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values is of a positive or negative maximum value. Thus, an absolute value of 
the voltage of B-phase when the A/D converted value of A-phase is 
substantially "0", and an absolute value of the voltage of A-phase when the 
A/D converted value of B-phase is substantially "0"are obtained by 
predetermined times, and the amplitudes "a" and "b" are determined to be 
respective average values of the absolute values of A-phase and B-phase. 
Thus obtained amphtudes "a" and "b" are multiplied by the conversion 
coefficient k, which is determined by amplification of the A/D conversion to 
the analog value (mV), to obtain the amphtude display data and the obtained 
ampUtude display data are displayed by the display section 28 and/or by the 
display device of the numerical controller 1 . 

FIG. 6 is a flowchart of the processing of obtaining the amplitude data to 
be executed by the processor of the motor controller 2 at every processing 
^ period. 

O The digital feedback signals f and g of A-phase and B-phase, 

g respectively, are read (Step 201). The offset data AA and AB obtained in Step 

^ SI are subtracted fi-om the read signals f and g, respectively, to obtain digital 

1^1 feedback signal data F and G with the offset canceled (Step 202). It is 

^ determined whether or not the A-phase digital signal F is substantially "0", i.e., 

f cY^?^ ^ ^^^^ centering "0" (Step 203). If the signal F is not substantially 

^ "0", it is determined whether or not the B-phase digital signal G is substantially 

^ "0" (Step 207). If the signal G is not substantially "0", it is determined 

W whether or not both of the indexes m and n reach the set value C (Step 211). 

g If both of the indexes m and n do not reach the set value C, the procedure of 

^ the present processing period is terminated. The indexes m and n, and 

registers R(G) and R(F) as described later are all set to "0" at the initial setting. 

Subsequently, the above processing is repeatedly executed at every 
processing period and when it is determined that the A-phase digital feedback 
signal data F is substantially "0" in Step 203, it is determined whether or not 
the index m reaches the set value C (Step 204). If the index m does not reach 
the set value C, an absolute value of the B-phase digital feedback signal data G 
obtained in Step 202 is added to the register R(G) (Step 205). Then, the index 
m is incrementally increased by "1" (Step 206) and the procedure proceeds to 
Step 207. 

Similarly, when it is determined that the B-phase digital feedback signal 
data G is substantially "0" in Step 207, it is determined whether or not the 
index n reaches the set value C (Step 208). If the index n does not reach the 
set value C, an absolute value of the A-phase digital feedback signal data F 
obtained in Step 202 is added to the register R(F) (Step 209). Then, the index 
n is incrementally increased by "1" (Step 210) and the procedure proceeds to 
Step 211. 

In the subsequent processing period, when it is determined that the 
A-phase digital feedback signal data F is substantially "0", the processing from 
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Step 204 to Step 206 is performed and when it is determined that the B-phase 
digital feedback signal data G is substantially "0", the processing from Step 
208 to Step 2 1 0 is performed. Then, when both of the indexes m and n reach 
the set value C, i.e., the digital feedback signals G and F when the data of the 
other phase is substantially "0" have been added to the values of the registers 
R(G) and R(F), respectively, by C times, the procedure proceeds from Step 211 
to Step 212. In Step 2 12, the value stored in the register R(F) is divided the 
set value C to obtain an average value of absolute values of the positive or 
negative maximums of A-phase as the amplitude "a" of A-phase. hi the same 
manner, the value stored in the register R(G) is divided the set value C to 
obtain an average value of absolute values of the positive or negative 
maximums of B-phase as the amplitude "b" of B-phase. 

The obtained amplitudes "a" and "b" are multiplied by the conversion 
1^ coefficient k, which is determined by amplification of the A/D conversion to 
b the analog value (mV), to obtain the amplitude display data and the obtained 
^ ampUtude display data are displayed by the display section 28 and/or the 
m display device of the numerical controller 1 (Step 2 1 3). It is determined 
y whether or not the amphtudes "a" and "b" (mV) are within the reference range 
W (Step 2 14) and the determination results for respective phases A and B are 

displayed on the display section 28 and/or the display device of the numerical 
1^ controller 1 . For example, if the amplitude of the feedback signal is within 
pJ the reference range, a sign "F" is displayed, if the amplitude exceeds the 
g reference range, a sign "H" is displayed and if the amphtude does not reach the 
g reference range, a sign "L" is displayed. Then, a signal indicating a 
^ completion of the amplitude data detection processing is outputted (Step 215) 
and the amplitude data detection processing of Step S2 is terminated. 

Then, a ratio between the amplitudes "a" and "b" obtained in Step S2 is 
calculated as follows; 

AmpUtude ratio = (B-phase amphtude/A-phase amplitude) x 100 (%) 

= (b/a)x 100 (%) 
The above amplitude ratio is sent to the display section 28 and/or the 
numerical controller 1 to be displayed by the display section 28 and/or the 
display device of the numerical controller 1 (Step S3). 

In the next Step S4, the phase difference of the feedback signals of 
A-phase and B-phase is obtained. First, a principle of obtaining an error a of 
the phase difference will be described. 

As described, the A-phase feedback signal F(e) with offset canceled and 
the B-phase feedback signal G(0) with offset canceled are expressed as 
follows; 

F(e) = asinO (1) 

G(0) = b-sin(e+90°+a) 

= b-cos(0+a) (2) 
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Assuming that the following relationship is fulfilled when 0 is of a value 

ei, 

F(ei) = G(01) (3) 

[{F(ei)}2+{G(e2)}2]i^ = Rl (4) 

Assuming that the following relationship is fulfilled when G is of a value 

62, 

F(02) = -G(e2) (5) 

[{F(01)}'+{G(02)}']''2 ^Rl (6) 

From the equations (1), (2) and (3), the following equation is obtained. 

tanGl = bcosa/( bsina + a) (7) 

From the equations (1), (2) and (5), the following equation is obtained. 

tan02 = b cosa/( b sina - a) (8) 

From the equations (4) and (6), the following equation is obtained 

(R2/R1)2 = [(l+tan^Giytan^Ol] x[tan2e2/(l+tan^02)] (9) 

The following equation is obtained by substitution using the equations 
(7) and (8), and rearranging the equation (9). 

sina = [(a^+b^)/2ab] x [(R2^-Rl^)/(Rl2+R2^)] 

Thus, the error of the phase difference is given by 

a = sin"^ [(a^+bV2ab] x [(R2^-R1 V(R1^+R2^)] (10) 

As described above, the error a of the phase difference is obtained 
according to the equation (10). Since the amplitudes "a" and "b" are akeady 
obtained in Step S2, the error a is determined by determining values of Rl and 
R2. 

FIG. 7 shows processing for obtaining the error a of the phase difference 
to be performed by the processor of the motor controller 2 at every 
predetermined processing period. 

First, the feedback signal data f and g of A-phase and B-phase, 
respectively, are read (Step 301). The offset data AA and AB obtained in Step 
SI are subtracted fi-om the feedback signal data f and g, respectively, to obtain 
the respective feedback signal data F and G of A-phase and B-phase with their 
ofiFsets canceled (Step 302). It is determined whether or not the feedback 
signal data F and G are equal to each other (F = G?) (Step 303). If the 
feedback signal data F and G are not equal to each other, it is determined 
whether or not the feedback signal data F and G have the same absolute value 
and different signs (F = -G?) (Step 307). If the determination result in Step 
307 is "NO", it is determined whether or not indexes p and q reach a set value 




C (Step 311). If the indexes p and q does not reach the set value C the 
procedure m the present processing period terminates. The indexes p and a 
register^ R(F) R(G), Q(F) and Q(G) are all set to "0" at the initial setting 
.1, determined that the feedback signal data F and G are equal To each 

fi^lll H l^^ ^7 ^«»^ti°^«hip expressed by ±e equation (3)Ts 

fulfilled, the procedure proceeds to Step 304 where it is determined whether or 
no the mdex p reaches the set value C. If the index p does not reach the set 
value c, the mdex p is mcrementally increased by "1" (Step 305) and the 
absolute value of the A-phase feedback signal data F obtained in Step 302 is 
added to the value of the register R(G) (Step 306), to proceed to Step 307 

If It is detenmned that the feedback signal data F and G have the same 
absolute value and different signs (F = -G) in Step 307, i.e., the relationship 
expressed by the equation (5) is fulfilled, the procedure proceeds to Step 308 
^ where It is determined whether or not the index q reaches the set value C If 
p the mdex q does not reach the set value C, the index q is incrementally 
g mcreased by "1" (Step 309) and the absolute value of the B-phase feedback 

fi"^^!^ ^ ^*^P is added to the value of the register Q(G) 

(Step 310), to proceed to Step 311. ^ 

hi Step 31 1, it is determined whether or not both of the indexes p and a 
reach the set value C and if both of the indexes p and q do not reach the set 
value C, die processmg of the present processing period is terminated 

Subsequently, the above processing is repeatedly executed until both of 
the indexes p and q reach the set value C, so that the absolute values of the 
^ A-phase and B-phase feedback data F and G when the feedback data F and G 
^ are equal to each otiier, are added to the register R(F) and R(G), respectively 
by C tunes. A^so, tiie absolute values of the A-phase and B-phase feedback 
data F and G when the feedback data F and G have the same absolute value and 
t^er°^ ^'^^ ^^^^^ ^^^^^^"^ ^^^^ respectively, by C 

When it is determined that both of the indexes p and q reach the set 
value C m Step 311, the respective values of the registers R(F), R(G), Q(F) and 
Q(G) are divided by die nmnber C. to obtain average values Fls, Gls, F2s and 
G2s as follows; (Step 312) 

Fls = R(F)/C 
Gls = R(G)/C 
F2s = Q(F)/C 
G2s = Q(G)/C 

The value of Rl in the equation (4) is determined based on thus obtained 
average values Fls and Gls, and the value of R2 in the equation (6) is 
determmed based on the average values F2s and G2s (Step 313), as follows; 

Rl =[Fls^ + Gls^]'^ 
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• R2 = [F2s^ + G2s^]'^ 

The error a of the phase difference is determined according to the 
equation (10) using the obtained Rl and R2 and the amphtude data "a" and "b" 
obtained in Step S2 (Step 314). 

A 90 degree is added to the error a of the phase difference and the 
obtained phase difference (90°+a) is displayed by the display section 28 and/or 
the data of the phase difference (90«+a) are sent to the numerical controller 1 
and displayed by the display device of the numerical controUer 1 (Step 315) 
Then, a signal indicating completion of the phase difference detection is 
outputted (Step 316) and the phase difference detection processing is 
terminated. 

c^T*'^' ^ obtained by subtracting the amphtude ratio obtained in 
Step S3 from "100" as the parameter for compensating the amplitude ratio and 
the error a of the phase difference obtained in Step 314 as the parameter for 
compensatmg the phase difference are stored in the storing section 27. The 
in amplitude ratio compensating parameter and the phase difference 
P compensating parameter are displayed by the display section 28 and/or the 
g display device of the numerical controller 1 (Step S5) and the encoder 

adjustment/confirmation processing is terminated, 
f . „ According to the present invention, it is not necessary to observe wave 
P forms of feedback signals inputted to a motor controller from an encoder with a 
pi special measunng device such as oscilloscope in adjusting/confmning the 
p analog feedback signals from the encoders, so that a state of the analog 

feedback signals is easily discriminated. Further, since the special measuring 
device is unnecessary and acceptability of the analog feedback signals is 
judged automatically, the adjustment and confirmation of the feedback signals 
are simplified and facihtated. 
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